中国科技核心期刊

中文核心期刊

CSCD来源期刊

空间控制技术与应用 ›› 2024, Vol. 50 ›› Issue (1): 25-34.doi: 10.3969/j.issn.1674 1579.2024.01.004

• 论文与报告 • 上一篇    下一篇

基于TEASER算法的空间非合作目标位姿估计

  

  1. 北京控制工程研究所空间光电测量与感知实验室
  • 出版日期:2024-02-26 发布日期:2024-03-26
  • 基金资助:
    国家重点研发计划(2018YFB0504500)、空间智能控制技术实验室开放基金 (2021JCJQLB01005)和光电测量与智能感知中关村开放实验室开放基金(LabSOMP202101)

Pose Estimation of Space NonCooperative Target Based on TEASER Algorithm

  • Online:2024-02-26 Published:2024-03-26

摘要: 基于点云的空间非合作目标位姿估计,常受到噪声影响. 提出截断最小二乘估计与半定松弛(truncated least squares estimation and semidefinite relaxation, TEASER)与迭代最近点(iterative closest point, ICP)的结合算法,提升空间非合作目标位姿估计精度与鲁棒性. 该方法包括粗配准与精配准两个环节:在粗配准环节中,基于局部点云与模型点云的方向直方图特征(signature of histogram of orientation, SHOT)确定匹配对,利用TEASER算法求解初始位姿;在精配准环节中,可结合ICP算法优化位姿估计结果. 北斗卫星仿真实验表明:在连续帧位姿估计中,噪声标准差为3倍点云分辨率时,基于TEASER的周期关键帧配准方法的平移误差小于3. 33 cm,旋转误差小于2. 18°;与传统ICP方法相比,平均平移误差与平均旋转误差均有所降低.这表明所提出的空间非合作目标位姿估计方法具有良好的精度和鲁棒性.

关键词: 空间非合作目标, 位姿估计, 点云配准, 截断最小二乘估计与半定松弛算法, 迭代最近点算法

Abstract: The pose estimation of space noncooperative targets based on point cloud is often affected by noise. In order to improve the accuracy and robustness of pose estimation for space noncooperative targets, a combination algorithm of truncated least squares estimation and semidefinite relaxation (TEASER) and iterative closest point (ICP) is proposed in this paper. The method includes two parts: coarse registration and fine registration. In coarse registration, the matching pair is found by the signature of histogram of orientation (SHOT) of local point cloud and model point cloud, and then the initial pose is solved by TEASER. In fine registration, ICP is used to optimize the pose estimation results. The Beidou satellite simulation experiment shows that when the noise standard deviation is 3 times the resolution of the point cloud, the translation error of the periodic key frame registration method based on TEASER is less than 3.33cm, and the rotation error is less than 2.18° in the pose estimation of continuous frames. Compared with the traditional ICP method, the average translation error and average rotation error are reduced. The results show that the proposed pose estimation method has good accuracy and robustness.

Key words: space noncooperative target, pose estimation, point cloud registration, truncated least squares estimation and semidefinite relaxation algorithm, iterative closest point algorithm

中图分类号: 

  • TN958.98